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Abstract ./ 

-I n ^v^uaiedthceff^crofllywnrics^cotiipcnaatwn 

in modcUbiisciixontrol-algof itHijj&i »-4rrthis paper; we evaluate the effect of changing ttadfontrol sampling period 
on the performance of the coiripu led- torque and independent joint control schemes^ While the former utilizes 
the complete dynamics model of the manipulator, the latter assumes a decoupled and linear model of the 
manipulator dynamics. discuss the design of controller gains for both the coinputed-torquc and the 

independent joint control schemes and establish a framework for comparing their trajectory tracking 
performance. Qys experiments show that within each scheme t.he trajectory tracking accuracy varies slightly 
with the change of The sampling rate. However, at low sampling rates the com puled- torque scheme outperforms 
the independent joint control scheme. Based on our experimental results, we also conclusively establish the 
importance of high sampling rates as they result in an increased stiffness of the system. / 


■tion /' 

mnv simuh'tiot/ results have 


f 


A|ihoii;’,h mnnv simuhtnuf results have been presented (id, 12. it. the real-time implementation and 
performance of model - based Amntrol schemes with high control sampling rates had not been demonstrated on 
actual manipulators, itn* il /recently [9, 11, 1 J . ’1 he main reasons for this have been the lack of a suitable 

manipulator system and the fact that it is difficult to evaluate the dynamics parameters for implementing 
model- based algorithms. One or the goals or the CMC Direct-Drive Arm II [Hj project has been to overcome 
those difficulties and evaluate the effect of dynamics compensation on the real-time trajectory tracking of 
manipulators. For the Aral-time computation of the inverse dynamics, we have developed a high-speed and 
powerful compuluiional/environmcnt. The computation of inverse dynamics has been customized for the CMU 
DD Arm II and a computation time of 1 mu has been achieved [5j. io obtain an accurate model we have 
i puted and measured the various parameters from the engineering drawings of the CMU DD Arm II by 


modeling each link asja composite of hollow anti solid cylinders, prisms, and rectangular parallelepipeds. We 
have also proposed aq algorithm to identify the dynamics parameters [8j which has been implemented on the 
CMU DD Arm II. The results of the experimental implementation of our identification algorithm are presented 
in [B, 7j. Finally, the negligible friction in our direct-drive arm especially makes it suitable to test the efficacy of 
the computcd-torque scheme. 


In our previous research, we investigated the effect of high sampling rate dynamics compensation in model- 
based manipulator control methods. Specifically, we compared the computcd-torque scheme which utilizes the 
complete dynamics model of the manipulator with the independent joint control scheme [9] and the feedforward 
compensation method [lOj. The control schemes were implemented on the CMU DD Arm II with a sampling 
period of 2 ms. In this paper, we investigate the effect of reducing the sampling rate on the trajectory tracking 
performance of manipulator control methods. Wc first compare the performance of each scheme as the sampling 
rate is changed. Next, we also compare the relative performance of both the computcd-torque and the 
independent joint control schemes at different sampling rates. 
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This paper is organized as follows: In Section 2, we present an overview or the manipulator control schemes 
that have been implemented and evaluated on the CMU DD Arm II. The design of controllers is discussed in 
Section 3 and the real-time experimental results are presented and interpreted in Section 4. Finally, in Section 5 
we summarize this paper. In the Appendix, we describe our experimental hardware set-up. 


2. Manipulator Control Technique* . 

The robot control problem revolves around the computation of the actuating joint torques/ forces to follow the 
desired trajectory. The dynamics of a manipulator are described by a set of highly nonlinear and coupled 
differential equations. The complete dynamic model of an N degrees-of- freedom manipulator is described by: 

r = D(0)0 + h(0,0) + g(0) ^ 

where r is the N - vector of the actuating torques; D(tf) is the NxN- position dependent manipulator inertia 
matrix; h(0,0) is the JV-vector of Coriolis and centrifugal torques; g(<?) is the .V-vector of gravitational torques; 
and 0, 6 and 0 arc /V-vectors of the joint accelerations, velocities and positions, respectively. 


This complex description of the system makes the design of controllers a difficult task. To circumvent the 
difficulties the control engineer often assumes a simplified model to proceed with the controller design. 


Industrial manipulators arc usually ton! rolled by <onveiilional I'UMvpe independent join' <«'.irol 'iruclurcs 
designed under the assumption that the dynamics <>f the links arc uncoupled and linear The controller* based 
on such an overly simplified dynamics model result in low speeds of operation and overshoot <• the end-elfoctor. 


To establish a framework for comparing the performance these two schemes, we consider the control law in 
two steps; computation of the commanded acceleration and computation of the control torque. The commanded 
joint accelerations u . can be computed in one of the following three ways. 


", - lyv") * K 


where K and K are jVx'.V diagonal position and velocity gain matrices, respectively. The .V vectors Oj and 0 
are the desired and measured joint positions, respectively, and the " indicates the time derivative of the 
variables. Whereas only the position error and the velocity damping is used in (2), the commanded acceleration 
signal in (3) uses a velocity feedforward term, and the commanded acceleration signal in (1) uses both the 
velocity and acceleration feedforward terms. The idea is to increase the speed of response by incorporating a 
feedforward term. 

The fundamental difference between the independent joint control schemes and the model-based schemes lies 
in the second step in the control law, i.e., the method of computing the applied control torque signals from the 
commanded acceleration signals. If the vector of actuating joint torques r is computed from the commanded 
acceleration signal under the assumption that the joint inertias are constant, then we obtain an independent 
joint control scheme. On the other hand, if the actuating torques r are computed from the inverse dynamics 
model in (1) then we obtain the computed-torque scheme. 

We have implemented computed-torque and the independent joint control schemes and compared their real- 
time performance as a function of the sampling rate. These schemes are described in the sequel. 

Independent Joint C ontrol (IJ.C1 

In this scheme, linear PD control laws were designed for each joint based on the assumption that the joints are 
decoupled and linear. The control torque r applied to the joints at each sampling instant is: 

' = 151 
where J is the constant iVx N diagonal matrix of link inertias at a typical position. 
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Comonted-Torone Control (CT\ 

Thl* scheme utilises nonlinear feedback to decouple the manipulator. The control torque r is computed bv the 
inverse dynamics equation in (1), using the commanded acceleration instead of the measured acceleration f: 

r - D{0)u t + fi(0,0) +■ g(fl) (6) 

where the " - • indicates that the estimated values of the dynamics parameters arc used *n the computation. 

The real-time control experiments using these schemes have been performed with the CMU DD Arm II. Also, 
we have used the Equation I to compute the accelerations for both the computed- torque and the independent 
joint control schemes. Before proceeding with the design of the controller gain matrices, we need to determine 
the order and transfer function of the individual joint drive systems. We achieved this by performing frequency 
response experiments. The details of these experiments are presented in (9, 6). 


3. Controller Design 

The performance of the nonlinear CT scheme and the linear IJC scheme can be compared only if the same 
criteria are used for design of the controller gain matrices. Fortunately, this is possible because the gain 
matrices K and appear only in the commanded accelerations which arc the same (Equation* (2)-(lj) for both 
CT and Ijfc schemes. Thus, whether we implement the simplistic independent joint control scheme or the 
sophisticated computed- torque scheme, we are faced with the problem of designing the gain mntric-s K p and 
K^. These matrices arc chosen to satisfy the specified output response criterion. 


3.1. Design of Cain Matrices for Independent Joint Control 
The closed loop transfer function relating the input 9^ to the measured output 0 } for joint j is: 

9 ,+fc 

j _ tij pj 

0 a tj rk J + fc 

v ) PJ 

where 7=1 if velocity feedforward is included and zero otherwise, and 6=1 if acceleration feedforward is 
included and zero otherwise. The closed-loop characteristic equation in all the three cases is, 


i* + k a + k =0 
VJ PJ 


( 8 ) 


and its roots are specified to obtain a stable response. The complete dosed- loop response of the system is 
governed by both the zeros and the poles of the system. In the absence of any feedforward terms, the response is 
governed by the poles of the transfer function. 

Since it is desired that none of the joints overshoot the commanded position or the response be critically 
damped, our choice of the matrices K p and K v must be such that their elements satisfy the condition: 

k = 2\fk~ for j = 1 6 (9) 

V) PJ * 

Besides, in order to achieve a high disturbance rejection ratio or high stiffness it is also necessary to choose the 
position gain matrix K p as large as possible which results in a large K u . 


3.2. Design of C.t'rn Matrices for Compute <l-Tor<|tir Scheme 
Till’ basic nlr. i behind (he c iiin|un i-d ii.rque m In uie is lo achieve ' dynam'ir decoupling <>f ill 'In joints using 
nonlinear feedbac k If the ilyiiaiiiu model of the manipulator is described l»v (l) ami ih<- applied control torque 
i« computed according lo ((>). then the following clu-ed-loop system is obtained 

0 u ( Dj '{ D D '0 -* h - (T{ t [k - R]} 

whi’re the functional dependencies on 0 and 6 have been omitted for the sake’ of c larity If the dynamics are 
modeled exactly, that is, D 1). ft- h and g=g, then the decoupled closed loop systcpi is described by 

0 - u 

I 
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Upon substituting the right hand side of either (2), (.1) or (-1) in the above equation, we obtain the closed-loop 
input-output transfer function of the system. The closed-loop characteristic equation in all the three cases is: 


+ k s 

'7 


+ *»- 


( 10 ) 


where k ■_ and Jc j are the velocity and position gains for the j-th joint. Upon comparing (8) and (10), we obtain 
the relationships 


f*7l 


'I JO, 


and 


k [uc\ 

P) pi "> V J ' 

which suggest that the gains of the IJC scheme are also the gains of the CT scheme. This equality must be 

expected because the closed-loop characteristic equation for both the independent joint control and the 
computcd-torquc scheme is the same. 


3.3. Gain Selection 

The gain matrices K and K f are a function of the sampling rate of the control system |3|. The higher the 
sampling rate the larger the values of K and K u can be chosen. Since the stiffness (or disturbance rejection 
property) of the system is governed by tlie position gain matrix a higher sampling rate implies higher stiffness 
also. In practice the choice of the velocity gain K fi is limited by the noise present in the velocity measurement. 
We determined the upper limit of the velocity gain experimentally: we set the position gain to xero and 

increased the velocity gain of each joint until the untnodeled high-frequency dynamics of the system were excited 
by the noise introduced in the velocity measurement. This value of K t , represents the maximum allowable 
velocity gain. We chose Hl)% of the maximum velocity gain in order to obtain as high value of the position gain 
as possible and still be well within the stability limits with respect to the unmodcled high frequency dynamics. 
The elements of the position gain matrix K were computed to satisfy the critical damping condition in (9) and 
also achieved the maximum disturbance rejection ratio. The elements of the velocity and position gain matrices 
used in the implementation of the control schemes arc listed in Table 1. 


I. Experiments and Results 

4.1. Trajectory Selection and Evaluation Criteria 
Since the DD Arm II is a highly nonlinear and coupled system it is impossible to characterize its behavior from 
a particular class of inputs, unlike linear systems for which a specific input (such as a unit step or a ramp) can be 
used to design and evaluate the controllers. Thus an important constituent of the experimental evaluation of 
rulxti mill rnl -i'Iioiiiv-i i- the ■ li.me «,f a eta- of input- for the roboi The criteria for -eleitmg the joint 
trajectories i- derailed in ;(>{. I u evaluating ihe performance of robot rontrol schemes. ve ii-e the dynamic 
tracking accuracy. This is defined a- the maximum position and velocity tracking error along a specified 

trajectory. 


\.‘l. Itenl-Tiine Results 

Iti our experiments we implemented both the independent joint control scheme and the computcd-torquc 
-rheme We evaluated their individual and relative performances by changing the sampling rate but keeping 
both the posit. on and the velocity gain matrices fixed. The maximum permissible velocity and position gains 
were chosen at a control sampling period of a ms (according to the tm tlnid outlined m Section d.d \ and remained 
fixed even when the sampling period was changed. I his allows us to determine the effect of the sampling rate on 
the trajectory trac king control performance We have also evaluated the best performance of the ( P method 
lor a sampling period of 2 ms with its best performance for a sampling period of a ms. We conducted the 
evaluation experiments on a multitude of trajectories but due to space limitations we present our results for a 
simple but illustrative trajectory. 

The ‘irst trajeetorv is chosen to be simple and relatively slow but capable of providing insight into the effect of 
dynamics compensation. In this trajectory only joint 2 moves white all the other joints are commanded to hold 
their zero positions and can fie envisioned from the schematic diagram in Figure I. Joint 2 is commanded to 
start from its zero position and to reach the position of 1 a rad tn 0.7a seconds; it remains at this position for an 
interval of 0.7a seconds after which it is required to return to its home position in 0 7a seconds. The points of 
discontinuity, in the trajectory, were joined by a fifth order polynomial to maintain the continuity of position, 
velocity and acceleration along the three segments. The desired position, velocity and acceleration trajectories 
for joint 2 are depicted in Figure 2. The maximum velocity and acceleration to be attained by joint 2 are 2 
rad/sec and b rad, sec*, respectively. 
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The position tracking performance of joint 2 for both the CT and IJC schemes, for a control sampling rate of 
200 Hz (corresponding to a control sampling period of 5 ms), is depicted in Figure 3. The corresponding position 
and velocity tracking errors are presented in Figures 4 and 5, respectively. We also depict the position tracking 
error of joint I in Figure 6 for both the CT and UC schemes. We note that the CT scheme outperforms the IJC 
scheme. For example, in the case of joint 2 the maximum position tracking error for CT scheme is 0.03 rads 
while for the IJC scheme it is 0.45 rads, approximately. In an earlier paper (9), we had compared both the CT 
and IJC schemes with a control sampling period of 2 ms. It must be noted that in the earlier reported 
experiments [9| the gains were selected for a control sampling period of 2 ms whereas in the present experiments 
the gains have been selected for a control sampling period of 5 ms. To put the results in perspective, we recall 
that in the earlier experiment the maximum position tracking error for the CT method was 0.022 rads while for 
the IJC method it was 0.036 rads. From the above observations it may be deduced that increasing the control 
sampling period from 2 to 5 ms results in a noteworthy degradation of the performance of the IJC scheme. A 
similar increase in the sampling rate also improves the performance of the CT scheme. 

In Figure 7, we depict the performance of the CT scheme as the sampling rate is increased from 200 H* to 500 
Hz. In this case the position and velocity gain matrices were determined for a sampling rate of 200 Hz and they 
remained fixed even when the sampling rate was increased to 500 Hz. Thus, Figure 7 presents the relative 
performance of the CT method as a function of the sampling rate only. We note that the trajectory tracking 
performance for both 200 Hz and 500 Hz sampling rates is comparable and has not changed in any appreciable 
muiirirr .utii ;m im in the sampling rate. Fii'.tire S depicts the results fur tin- IJC' method when :i similar 
cxpcriiiu nt was performed. In this case also we do not observe my appreciable change in performance when 
only the sampling rate is changed. 

Thus, from the above set of experiments the following conclusions may be drawn: 

1. If lh< gjinx are sc Idled for a lower sampling rate and then if the sampling rate is increased, while 
keeping the gains fixed, there is no appreciable improvement in the performance of both the C'T and 
the IJC schmes. 

2. At lower sampling rates the CT scheme outperforms the IJC’ method. Kven though the disturbance 
rejection ratio of both the schemes is diminished, it docs not appreciably affect the CT method 
because of the compensation Tor the nonlinear and coupling terms. Whereas it affects the IJC 
method because the disturbance that is constituted by the nonlinear and the coupling terms is not 
rejected appreciably. 

1. If the maximum possible gains are selected for the chosen sampling rates then the performance of CT 
at a higher sampling rate is better than its performance at a lower sampling rate. A similar 
comlusion is drawu for Lhe IJC scheme also. 

Our List conslusion is especially significant because it suggests that a higher sampling rate does not only imply 
improved performance but it also allows us to achieve high stiffness. It is desirable for a manipulator to have 
high stiffness so that the effect of unpredictable external disturbances on the trajectory tracking performance is 
significantly reduced. 

5- Summary 

In this paper, we have presented the first experimental evaluation of the effect of the sampling rate on the 
performance of both the computed-torque and the independent joint control schemes. W'e have discussed the 
design of the controller gains for both the independent joint control and the computed-torque schemes and 
established a framework for the comparison of their trajectory tracking performance. Based on our experiments 
we have demonstrated that the computed-torque scheme exhibits a better performance than the independent 
joint control scheme. Our experiments also show that high sampling rates are important because they result in a 
stiffer system that is capable of effectively rejecting unknown external disturbances. 
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I. The CMU DD Arm II tK . 

We have developed, at CMU, the concept of direct-drive robots in which the links are directly ‘ouplcdto 
motor shaft. This construction eliminates undesirable properties like friction and gear backlash. The OMU uu 
Arm D (14] is the second version of the CMU directrdrivc manipulator and is designed to be faster, lighter 

more accurate than its predecessor CMU !>l> Arm 1 (-]• We have used brush!™ rare-earth m^ne. DC Jor-iuc 
motors driven by current controlled amplifiers to achieve a torque controlled joint drive system. I he 
type configuration of the arm reduces the the lorq.ic requirements or the first two joints and also simplifies the 
dynamic model of the arm. To achieve the desired accuracy, wc use very high precision (1G bils/rotation) rotary 
absolute encoders. The arm weighs approximately 70 pounds and is designed to achieve maximum joint 
accelerations of 10 rad/sec^. 

The hardware of the DD Arm II control system consists of three integral components: the Motorola MGSOOO 
microcomputer, the Marinco processor and the TMS-320 microproecssor-bascd individual joint controllers. Wc 
have also developed the customized Ncwton-Eulcr equations for the CMU DD Arm H and achieved a 
computation time of 1 by implementing these on the Marinco processor. The details of the customized 
algorithm, hardware configuration and the numerical values of the dynamics parameters are presented in [aj. 


Joint (j) 

Transfer Function ( —W) 

V 



l 

l 

12.3 s 1 

2.75 

3.33 

2 

1 

2s 1 

15.0 

7.5 

3 

1 

0.25s 1 

256.0 

32.0 

4 

1 

0.007s 1 

1285.0 

71.5 

5 

1 

0.006s 1 

625.0 

50.0 

6 

1 

0.0003s 1 

1110.0 

50.0 


Table 1: Transfer Functions and Gains of Individual Links 



Figure I: Schematic Diagram of 3 DOF PD Arm U 
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Figure 6: Position Tracking Errors of Joint 1 



Figure 4: Position Tracking Error of Joint 2 
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Figure 7s Performance of CT as a Function of Sampling Period 
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Figure 8s Performance of IJC as a Function of Sampling Period 
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